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RECURSIVE IMPLEMENTATIONS OF THE CONSIDER FILTER 

Renato Zanetti and Chris D’Souza 1 ^ 


One method to account for parameters errors in the Kalman filter is to 
consider their effect in the so-called Schmidt-Kalman filter. This work 
addresses issues that arise when implementing a consider Kalman filter as 
a real-time, recursive algorithm. A favorite implementation of the Kalman 
filter as an onboard navigation subsystem is the UDU formulation. A new 
way to implement a UDU consider filter is proposed. The non-optimality 
of the recursive consider filter is also analyzed, and a modified algorithm 
is proposed to overcome this limitation. 


INTRODUCTION 

Consider analysis was introduced by S. F. Schmidt of NASA Ames in the mid 1960s as a 
means to account for errors in both the dynamic and measurement models due to uncertain 
parameters [1]. The consider Kalman filter, also called the Schmidt-Kalman filter resulted 
from this body of work. The consider approach is especially useful when parameters have 
low observability or when the extra computational power to estimate them is not deem 
necessary [2]. 

Schmidt’s approach is based on minimum variance estimation, Jazwinski [3] details the 
derivation of the optimal consider Kalman filter. In Section 8.2 of his book, Bierman [4] 
disputes the optimality of the Schmidt-Kalman filter, at least in its sequential implementa- 
tion. Nevertheless the Schmidt-Kalman filter has received considerable attention in recent 
years. Tapley et al. [5] give an ample description of the consider Kalman filter, they pro- 
vide a different methodology then Jazwinski and arrive to a different formulation. Wood- 
bury et al. provide new insight into considering parameters in the measurement model [6] . 
Equivalent formulations to the consider filter were also studied [7, 8] and applied to Mars 
entry navigation [9] and orbit determination [10]. 

While the Schmidt-Kalman filter is very well known, not much attention has been given 
to actual implementations of it in a real-time recursive estimation algorithm. Onboard es- 
timators commonly utilize the UDU formulation, which guarantees symmetry and positive 
definiteness of the covariance. To date there is no direct way of including a consider update 
into the UDU formulation, this paper provides a simple algorithm to obtain this capability. 
Another common practice is to process measurements one at the time (which is inevitable 
when utilizing the UDU algorithm). When processing measurements one at the time in the 
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Schmidt-Kalman filter the order in which they are processed affects the final result. This 
work analyzes this phenomenon and proposes a globally optimal consider filter, which ad- 
dresses the objections raised by Bierman. 

THE KALMAN FILTER UPDATE 

This work assumes linear measurements and dynamics, the extension to the nonlinear 
case can be readily obtained using standard extended Kalman filter techniques. Let y be a 
set of measurements of a state vector x corrupted by zero mean noise rj with covariance R 

y = Hx + 77, (l) 

where H is the measurement mapping (or sensitivity) matrix. Let x~ be an unbiased es- 
timate of x with corresponding estimation error covariance given by P . The a priori 
estimation error is given by 


e = x — x . ( 2 ) 

The unbiased linear update based upon x~ and y produces the a posteriori estimate given 
by 

x + = X" + K (y - Hx ) , (3) 

where K is some determinist matrix of appropriate dimensions to be determined. The a 
posteriori estimation error expressed as 

e + = x — x + = (I — KH)e' - K 77 . (4) 

Assuming that the measurement error 77 and the a priori estimation error, e are uncorre- 
lated and each are zero mean, we find that the a posteriori estimation error covariance is 
given by the so-called Joseph update: 

P + = E { (x - x+) (x - x + ) T | = (I - KH)P~(I - KH) t + KRK t , (5) 

where I is the identity matrix of appropriate dimension and R is the measurement error 
covariance matrix. 

Defining the covariance of the measurement residuals, W, as 

W = HP H 1 + R, ( 6 ) 

the updated {a posteriori ) covariance is equivalently written as 

P + = P - KHP~ - P H t K t + KWK 1 . (7) 

Notice that up to now no assumptions have been made as to the choice of K and the Joseph 
update equation is valid for all K, as is Eq. (7). The standard Kalman gain K opt minimizes 
the trace of the updated covariance matrix, P + 

K opt = P H T W _1 . ( 8 ) 
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Substituting this into Eq. (7) it follows that 


opt 


- K opt HP~ 

= p- - Ko ?( wk; 


(9) 

( 10 ) 

(ID 


= P~ - P-H T W _ 1 HP- 
These equations are only valid for the optimal gain, K opt . 

THE SCHMIDT-KALMAN FILTER UPDATE 

Suppose now that we partition x into n s “estimated” states, s, and n p “consider” param- 
eters, p as 

r - 
S 


A 

X = 


P 


( 12 ) 


preserving the fact that n x = n s + n p , i.e. the total number of states is unchanged. Let us 
now partition the relevant matrices accordingly. Thus, 


P P 

Pps Ppp 
H = [H s H p ] 




K- s,opt 


r p h t + p h t l 

SS S 1 sp p 

Kp , 0 pt 


P h t + p h t 

L ps s 1 PP P J 


W 


-l 


(13) 

(14) 

(15) 


As in the previous section 

W = HP H 1 


H s P“Hg 


R 


HsPgpHp 


P + 

sp 


ps 


sp 


K S H 


K S H 


The updated portions of the covariance are 

P + = P 
P 
P 
P 


rp-' 

ss 


rp-i 

ss 

p- 



L psj 


L psj 


HpP ps Hj 


H r Kj+K s WK 

h t kJ+k s wkJ 


HpP pp H p r 


T 


R 


(16) 


ps KpH 


P sp 

L P PP. 


P 

L ps. 


P 

L ps. 


sp 

p 

Lr pp. 


pp 


pp K p H 


rp-i 


rp-i 

sp 


sp 

p- 


Prir, 

L ppJ 


L ppJ 


H r Kj + K p WKj 


H r Kj + K p WKj 


(17) 

(18) 

(19) 

( 20 ) 


These equations are derived from Eq. (7) and are therefore valid for any choice K s and K p . 

We now choose the K s and K p carefully such that the gain for the states is the optimal 
value Ks opi from Eq. (15) and allowing K p to be (as yet) unspecified. Thus, substituting 
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for the value of K s )0pt for the three components in Eqs. ( 17)— ( 1 9), it becomes 


>+ 


P ss K Sj0 j,(WK SOJ)( 


P Sp K-soptH 



rp- 1 

T 

rp- 1 


rp- 1 

Pps- 

sp 

^Pppj 

H T K l opt P pp -KpH 

sp 

^Pppj 

— 

sp 

^Pppj 


P s P 

L P PP. 

T 


H 1 Kp + K p WKp 


(21) 

This equation is valid for any value of K p . Notice that there is no K p in the cross- 
covariance between s and p. Therefore, what is remarkable about this equation is that 
once the optimal K Sj0pt is chosen, the cross-covariance between s and p is independent of 
the choice of K p . We will take advantage of this property in due course. 

We note that the updated ( a posteriori) state is given by 


K s 

K, 


(y - H s s - H p p ) , 


( 22 ) 


a consider filter is one in which the parameters, p, are not updated. From Eq. (22) it is 
observed that this can be achieved by taking K p = O. With this in mind, we start again 
from the most general covariance update given in Eq. (7) and we obtain that the a posteriori 
consider covariance matrix is 


>+ _ 



rp- ] 


r P - ] 

T 

rp- 1 

p ss -k s h 

|PpsJ 

— 

|PpsJ 

H T Kj + K s WKj Pgp — K s H 

sp 

^Pppj 


ps 


sp 


pp. 


Ttv-T 


H X K 


pp 


(23) 


To find the optimal consider K s we take the derivative of the trace of the covariance matrix 
with respect to K s and set it to zero 

i T 


d 


0K« 


(trace [P+ n ] ) = 


rp- 

T 

rp -1 

L p P sJ 

h t - 

L p pJ 


H J 


K Sopt W' J 


Ks op (W = O. (24) 


The result is the same as for the globally optimal Kalman filter, so that the optimal consider 
Kalman filter, also called the Schmidt-Kalman filter can be conveniently calculated from 
the optimal filter by zeroing out the rows corresponding to the consider states. 


K,„„ = IV H 


P“ H t 1 W _1 

sp p ) T * 


So that the consider gain is 


Ik ( on 


PH 

ss s 


T 


o 


P H T 

sp AA p 


W- 1 = 


K 


s ,opt 

O 


(25) 


(26) 


The state update is 


s + = s + K s (y - H s s - H p p ) 
P + = P • 


(27) 

(28) 
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It must be stated emphatically that the full updated covariance matrix (the a posteriori 
matrix) must be calculated by means of the Joseph update. We cannot use Eq. (11), for 
that equation was valid only for the optimal gain; we have a chosen a sub-optimal gain or 
a non-globally optimal gain (i.e. the optimal gain corresponding to K p = O). Substituting 
K St0p t into Eq. (23) we obtain 


-K s , op ,WK s r opt 


iPps- 


Psp 

L P PPJ 


ttIt^T 

1 1 iv s,opt 


F*sp 


pp 


sp 


PPJ 


(29) 


Several comments are in order: 


1. When using the Schmidt-Kalman filter, the a priori and a posteriori covariance of 
the parameters (P pp ) are the same. 

2. The a posteriori covariance matrix of the states and the cross-covariance between the 
states and the parameters are the same regardless of whether one uses the Schmidt- 
Kalman filter or the optimal Kalman filter. 

It follows that the a posteriori consider covariance can be obtained from the a posteriori 
optimal covariance by replacing P+ p with P pp . 

Finally, item (2) above does not mean that P ss from the optimal Kalman filter will be 
the same for all time as for the Schmidt-Kalman filter. Rather, it means that given the same 
a priori covariance the two algorithms will produce the same a posteriori covariance for 
P ss and P sp . However, since P pp is different between the two algorithms, after the very 
first update, the subsequent a priori covariances will be different henceforth, producing 
different results. We will expand to this point in due time. 

THE UDU UPDATE 

A common strategy to implement covariances in real-time flight software is to use theUDU 
formulation [11]. Thus, the covariance matrix is decomposed as 

P = UDU t (30) 

where U is an upper triangular matrix with ones on the main diagonal, and D is a diagonal 
matrix. In order to efficiently update U and D with measurements, the so-called ‘rank-one’ 
update proposed by Agee and Turner is sometimes used [12]. The rank-one (covariance) 
update requires that measurements are processed one at a time and has the form 

P + = P + caa T (31) 

where c is a scalar and a is a vector. IfweletP 4 " = U + D + (U + ) T and P~ = U~D~(U _ ) T , 
then the update must have the form 

U+D + (U+) T = irD~(ir) T + caa T (32) 
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The algorithm for the rank-one update is backwards-recursive for U + and D + , starting 
with the (n,n) element (D nn ) and ending with the (1, 1) element (Du) and it is seen in 
Table 1. 


For j — n,n — 1, . . . , 3, 2 set c n — c and recursively calculate: 

n .U =_ D 7i + r -i a j 

a k ■= ak - djU kj k — 1,2, ... j — 1 

u kj = u kj + Ckajdk/D J. k = 1, 2, . . . j - 1 

9-i = c J D p/ D n 

and finally compute 

D n = D u + c i a 1 


Table 1. Backwards-Recursive Rank-One Update 


For scalar measurements H and K become vectors and W is a scalar. We recall that 
from Eq. (11) that the optimal update of the covariance matrix is 

P+* = P“ - P-H T W - 1 HP- 


Thus, 


U+D + (U + ) T = U _ D _ (U _ ) t — U^D^CU - ) 1 !! 1 W _i HU _ D~(U 


-\TijT-iir-li 


T-^T 


= U- 


D 


-^D (U ) T H T HU D 

W 


(U 


-\T 


Defining 


A 

a = 


A 

C = 


D“(U") t H t 

1 

~W 


U + D + (U + ) T becomes 


U+D + (U+) t 


U- [ID I + caa T ] (U~) T , 


(33) 

(34) 


where I is the identity matrix (which is upper triangular with ones on the diagonal). We now 
proceed with the rank-one update of the term in the square bracket, defining an intermediate 
step to the solution as 


UDU t = ID I + caa T 
The updated matrices are given by 

u+ = U U and D + = D 


(35) 
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Since c is negative, this measurement update involves the potential loss of precision due 
to subtraction of two positive numbers which are close to one another, a modification of 
the rank-one update is due to Carlson [13], resulting in a forward-recursive algorithm, one 
which is numerically stable. This modified algorithm is only valid for the optimal Kalman 
update, K opt . The updated U and D (U + and D + , respectively) and the optimal Kalman 
gain matrix, K opt , are produced by this algorithm, which is detailed in Table 2. 


Given H, U, D, R = R 
f = U T H T 
v = Df 

K 1 = [m 0 0] T 

a 1 — R + vifi 
d\ = dn = dn 

For j — 2,3, ... , n, recursively calculate: 

a j = a j - 1 + v jfj 

d d ( 'U-A J.. 

T? ^ aj J n 

Aj = 1) 

Uj = U j + AjKj_i 
K-j = K-j - 1 + VjXJj 

and finally compute 

K-opi K n / ol 


Table 2. The Forward-Recursive Modified Rank-One Update 


The updated state is computed as before, i.e. 

x + = x~ + K opt (y - Hx") 

THE SCHMIDT-KALMAN FILTER UDU UPDATE 


(36) 


Recall that the Schmidt- Kalman update to the covariance matrix due to the measurements 
was stated in Eq. (29) as 


>+ 


f*ss K S)0 p(WK SO p t 


ps 


sp 

p 

L 17 PPJ 


H T K 


P sp -K s , opt H 


pp 


sp 


pp. 


Unfortunately, the structure of the matrix in Eq. (37) does not allow for a rank-one update 
as we developed earlier. We stated earlier that to obtain the updated consider covariance 
we can begin with the updated optimal covariance and replace P pp with P pp . Now, from 
Eqs. (10) and (11), we have 

-T 


opt 


k ¥ wk; 


(37) 
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From these relations, we see that the optimal a posteriori covariance is equal to the a priori 
covariance minus a delta covariance. We can, therefore, harness this idea to help us along. 
With the optimal value for K p , we obtain 


p+ — 

1 opt 


f*ss K S)0 pi"WK S)0 , pt 


F*sp K S)0p iH 


ps 


n T 


sp 


PP- 


sp 


pp. 


FT t K t P —K wtc 1 

xx xv s ,opt x pp XV P ,opt. YV xv p ,opt 


(38) 


This, of course can be written as 


opt 


P ss - K S)OJrf WK s ^ opt P sp -K S)0pt H 


sp 


pp. 


ps 


sp 

p 

L r PP. 


H T K^ 


pp 


O r 

O r 


On s X7i p 

Kp^WK^ 


(39) 


Thus, we can rewrite Eq. (39) as 


p+ 

1 opt 


O, 


o, 


0 71p xn s Kp ]0 j, t WK p ()p( 


(40) 


Recalling from Eq.(15) that the optimal gain is partitioned as 


K — 

r^opt — 


K 

K 


s ,opt 
p ,opt 


Defining S as 


S = 


o 

o 


n s xn s ^n s xn 


Or 


n p xn s A fi p xn p 


(41) 


Eq. (40) becomes 


Pit = P in - W (SK upi ) (SKopt) 


(42) 


We note that S is an n x x n x matrix (recalling that n x = n s + n p ) and K. opt is an n x x 1 
vector, because we are processing the measurements as scalars. Therefore SK opt is an 
n x x 1 vector. Therefore, 

PL = pjt + W (SK„ pl ) (SK opi ) T (43) 

This has the same form as the rank-one update as found in Eq. (31), i.e. P + = P + caa T . 
While earlier the scalar was negative for the optimal update creating potential numerical 
issues, now 


(44) 

(45) 
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a — SK 0 pj 
c = W. 



With this in mind, we can use the (un-modified) rank-one update which is a backward- 
recursive update. If, for example, all the consider parameters are in the top part of the 
state-space, we can effectively reduce the computations because the second update will not 
modify the columns of U and D corresponding to the estimated states. 

Finally, the states (and the consider parameters) are updated as 

s + = s-+K s (y-H s s--H p p-) (46) 

p+ = p (47) 

Of course, this is identical to what was obtained in Section 3. 

Therefore, the procedure is as follows: first perform a complete rank-one measurement 
update with the optimal Kalman Gain (K opi ) according to the modified rank-one update (as 
in Table 2) - on the full covariance matrix. Second, perform another rank-one update with 
a = SK opt and c = W, according to the (un-modified) rank-one update (as in Table 1). If 
the consider parameters are always the same across flight we place them conveniently to 
reduce computations. 


OPTIMAL CONSIDER FILTER 

Through a logic construction, Bierman [11] states that the recursive Schmidt- Kalman 
filter is non-optimal because processing data as multiple batches provides a less accurate 
result that processing it all at one. We now demonstrate that statement and we propose a 
solution to overcome the nonoptimality of the Schmidt-Kalman filter. 

Suppose we divide the measurement vector into two uncorrelated batches y 1 = [yj yj] . 
It is well-known that processing the two batches together or sequentially using the Kalman 
filter equations produces the same result [14], i.e. defining 



K opl = p-H T (HP H-lif 

(48) 

= (i - k^,h„) p-, 

K‘ v , = p-H T a (H.P-HJ' + R^)- 1 

(49) 

p£* = (i - k^h,) p^„ 

K^ = P^Hj(H t P^X + R*) _1 

(50) 

then P + 1 = ~P b opt . Processing all the measurements at once using the consider gain 


P FT t 4- P FT t 

K - " " + r sp n p p H r 

— Q SS AJ -S 

+ H s P“ p Hp + H p Pp S Hj + H p PppHp 

+ R) _ 


we have that s + , P+, P+ s have the same values for both the Schmidt-Kalman filter and the 
regular Kalman filter. If we process the first batch of measurements with the consider gain 
we have that P“ s opt = P“ s , con , P ps , opt = P' ps . op/ , but P “ p <opt P pp ., on = P pp . Therefore 


TT p a U 1 

ss,con*-*-s 


TT pa TT 1 

sp, con J " l -p 

tt pa ttT 

n s r ss,opt n s 


TT p a U 1 

ps,con*-*-s 

tt pa ttT 

“s-^sp, opt -“-p 


TT pa TT 1 I 

n P r pp,con n p ' 

' TT P a ttT 

I1 P r ps,opt I1 s 


Rf, > 

I tt pa ttT 

"T n P r pp,Opt n p 


f R/, 

(51) 
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hence the rows of K| ; on corresponding to the estimated states will be “smaller” than the 
corresponding rows of K. b t , resulting in a smaller update. 

Previously we derived the “optimal” consider filter by minimizing the trace of the pos- 
terior covariance. The optimality holds only if all measurements are processed at once and 
for a given prior covariance. Processing all measurements at once is more accurate than 
processing them in two batches, which in turn is more accurate that processing them in 
three batches, and so on. While this result might not seem of great consequences (usually 
only a few measurements are available at each given time), it has one larger implication: 
the fact that processing all measurements together or in batches produces equal results it is 
the key to optimality of the recursive Kalman filter. In the Kalman filter only the current 
measurements are incorporated, this measurement update is followed by propagation to the 
time of the next measurements. This procedure is equivalent to processing all the current 
and past measurements at once. In standard aerospace applications, measurements can be 
incorporated in hundreds of batches, one for each time the filter update phase is invoked. It 
is therefore essential to use a recursive estimator. 

In previous sections it was noticed that we can incorporate the measurements using the 
regular Kalman filter update of the states, while leaving the parameters unchanged. The 
full covariance can be updated first using the entire Kalman gain and we then substitute the 
optimal P+ p with the prior P pp . Adopting this strategy we obtain exactly the same result 
as the Schmidt- Kalman filter. More importantly we could update the covariance and the 
states in many batches, and only after the last batch is processed we would substitute P pp 
with P pp . 

An optimal recursive Schmidt- Kalman filter that gives identical results to a batch esti- 
mator is obtained by implementing a regular Kalman filter in which the entire covariance 
is updated and propagated at all times, but only the estimated states are updated using the 
measurements, while the consider parameters remain unchanged across measurements. As 
discussed earlier the optimal consider filter and the Kalman filter share the same estimate 
of the states, their covariance, and their cross-covariance with the consider parameters. The 
covariance of the parameters of this optimal consider filter does not represent their actual 
uncertainty, instead it represents the uncertainty the parameters would have if they were 
optimally estimated. If it is desired to know what the uncertainty of the parameters actu- 
ally is, another, smaller, covariance of only the parameters needs to be carried. This “true” 
covariance is never actually used by the filter nor changes in the measurement update phase. 

NUMERICAL RESULTS 

In this section we present a very simple numerical example to demonstrate the theory 
developed in this paper. A single state s and parameter p for the state vector x T = [s p] . 
The state is measured directly, while the parameter is a systematic measurement error 

Vk = s k + Pk + Vk = [l l] x fc + r)k = Hx fc + p k (52) 

where rp. is a zero mean, white sequence with variance R k = 1 and uncorrelated from any 
other error source. The true state is a random walk while the parameter is a first order 
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Markov process 


Xfc-fl = <FfcXfc + v k 


1 

0 


0 

g— Atfc/r 


Xfc + 


l^k 


( 53 ) 


where u k and ///,. are zero mean, uncorrelated white sequences with variances given by 
Qk = 1 and (1 — e~ 2Atk t r )P mss , respectively. The steady-state value of the Markov process 
variance is chosen as P pPtSS = 1 and the time constant r is such that e -200//r = 0.5. An 
initial unbiased estimate xj = [0 0] of the true state vector is available and has associated 
estimation error covariance given by 


Po = 


10 3 
3 1 ‘ 


( 54 ) 


A first measurement y 0 is assumed to be available at time t 0 = 0 and a second measurement 
yi becomes available at time t\ = 100. A standard Kalman filter implementation performs 
a first update and produces 


Pa'f(^o) 


0.6111 0.1111 

0.1111 0.1111 ‘ 


The next step is a time update after which 


1.6111 0.0786 
0.0786 0.5556 ' 


Finally a second update is performed that produces 


P/CF^l) 


0.7522 -0.2438 

-0.2438 0.4346 


( 55 ) 


( 56 ) 


( 57 ) 


From the discussion above and since the initial uncertainty of the parameter coincides 
with its steady-state value we know that an optimal consider filter provides an estimate with 
error covariance 


P 


+ 

OCKF 


(*l) 


0.7522 -0.2438 

-0.2438 1 


( 58 ) 


however applying the Schmidt- Kalman filter equations recursively we obtain after the first 
update 


P 


+ 

CKF 


(to) 


0.6111 0.1111 

0.1111 1 


( 59 ) 


after the propagation 


' CKF(t 1 


1.6111 0.0786 
0.0786 1 


( 60 ) 


and finally after the second update is 


P 


+ 

CKF 


(tl) 


0.8535 -0.4051 

-0.4051 1 


( 61 ) 
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The optimal consider filter algorithm proposed in this paper carries the covariance of the 
Kalman filter with the understanding the the portion corresponding to the covariance of the 
consider parameters is fictitious. At any time it is desired to know the actual covariance 
it can be built from the Kalman filter covariance and an externally carried covariance of 
the parameters. For the simple example in this section the parameter’s covariance stays 
constant at its steady state value. To demonstrate the validity of this method a Monte 
Carlo simulation is performed. True initial states are obtained sampling from a Gaussian 
distribution with mean x 0 and covariance P 0 . Each Monte Carlo run also samples different 
values for the process noise and measurement noise, with zero mean and covariance as 
specified above. The propagation phase is given by 

x fc+ i = $ fc x fc . (62) 

Figures 1 to 3 show the results of 100 Monte Carlo runs for each algorithm. The figures 
convey that all the algorithms perform correctly since their predicted estimation error is 
consistent with its actual value. Figure 4 shows a comparison of the three algorithms. All 
the covariances shown in the plots are 3a values. 

CONCLUSIONS 

This paper analyzes recursive implementations of the consider filter. A recursive imple- 
mentation is essential for onboard estimation systems. A common strategy for aerospace 
navigation is to carry the filter’s estimation error covariance utilizing the UDU formulation. 
This paper introduces a formulation of the UDU consider filter. The non-optimality of the 
recursive consider filter is discussed. An algorithm is proposed to overcome this limitation 
and produce optimal consider filter results. A numerical example is shown to demonstrate 
the validity of the proposed approach. 
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